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5. Linearisation des problemes non lineaires : 

La formulation du filtre presentee plus tot est basee sur un modele lineaire des systemes et elle n'est 
done pas applicable dans les situations ou le modele du systeme ou le modele de la mesure ou bien 
les deux sont non-lineaires. Ainsi, le probleme principal dans ces cas est de lineariser d'abord le 
modele, et puis d'appliquer le filtre standard de Kalman pour obtenir I'etat du systeme. Un certain 
nombre de methodes ont ete developpees dans cette direction; ici nous discuterons deux de telles 
approches. 

Quand la linearisation se fait autour d'une certaine trajectoire nominate dans I'espace d'etat qui ne 
depend pas des donnees de mesure, le filtre resultant s'appelle le Filtre Linearise de Kalman [4]. La 
linearisation autour d'une trajectoire (estimee) qui est continuellement mise a jour avec les 
estimations d'etat resultant des mesures s'appelle le Filtre de Kalman Etendu [5]. Dans les deux cas, 
la linearisation est faite en utilisant la serie de Taylor. 
Nous examinerons maintenant ces approches en detail. 

5.1 Le Filtre de Kalman Linearise : [4] 

Dans le filtre linearise de Kalman, la linearisation est faite autour d'une certaine trajectoire 
nominale, qui ne depend pas des donnees de mesure, c.-a-d. que I'expansion en serie de Taylor 
utilisee pour la linearisation est evaluee a un certain point nominal connu 

Considerez un modele non-lineaire d'un systeme defini comme suit : 

Modele du processus: Xj^ = f{X]^-i, ^k-l) "I" ^k-1 (1.56) 

Modele de mesure: Z^ = h(Xk) + V^ (1-57) 

La ou,/et h sont des fonctions non-lineaires connues, Uj^ est la fonction (le vecteur) de commande 

et Wj^ et Vj^ sont des processus de type bruit blanc non correles. La non-linearite pent resider soit 
dans le modele du processus soit dans le modele de mesure soit dans les deux fonctions. 
Supposez qu'une trajectoire approximative Xj^^^^ (figure. L3) puisse etre determinee par un 
quelconque moyen; celle-ci est referee en tant que trajectoire nominale (la trajectoire de reference). 
La trajectoire reelle (actuelle) Xj^ pent etre ecrite en termes de X]/^^^ et d'erreur b Xj^ comme 
suit: 

Xk = Xk^^^ + Sxk (1.58) 

Les equations, (L56) et (L57) deviennent alors : 

Xfe"«- + Sx, = f(Xfc_i"«- + 6 xj,_„ Uk_i) + Wk_i (1.59) 

Zk = hCxk""'" + Sx,) + Vk (1.60) 
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Figure 1.2 : Trajectoire nominale et reeiie pour un filtre linearise de Kalman 



Par Tapplication de Texpansion de serie de Taylor dans Tequation (1.59) et en supposant que 
Sxj^ est petit, nous allons realiser une expansion de / autour de Xj^^^^ en ne gardant que le terme 
de premier ordre : 

f (x;i._i"'"",Uk_i) + — |x=X|t_i"<"" ■ 5 X/(._i + terme d'ordres elevesj + Wk_i (1.61) 

ffv nom ,, ^ ^ nom 

=> 8 Xj^ ^ Fk_i 8 X/(._i + Wk_i (La dynamique linearisee) (1.62) 

Ou 



Fk-i = 







rdf. 


dfi 


df, 1 






dxi 


dx2 


3X3 




dfl 




di2 


dh 


af2 




.dx\ 


X=Xfc_i"'"" 


dxi 


dX2 


5X3 








- 




- 


^=xnom 



(1.63) 



et 

Wk-N(aQk) 

En negligeant le second terme et les termes d'ordres superieurs, la prediction de I'etat est propagee 
par les equations non-lineaires tandis que les erreurs d'etat le sont par un systeme lineaire separe. 

Maintenant, la mesure pent etre egalement linearise en utilisant I'expansion de la serie de Taylor, en 
linearisant h a X]J^^^ et negligeant les termes d'ordres superieurs. 
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Zk = (h(x/(."''"^) + — |x=Xfc_i"'"" -S^k + terme d'ordres elevesj + v^ (1.64) 

6 Zk « Zk - h(x,--) 

=> 6 Zk ~ Hk Sx]^ + Vk(Equation de mesure linearisee) (1.65) 



Ou 



H. = 



ah 



Lax 



X=Xk' 



ahi ahi dhi 



dxi dx2 5x3 
ah2 5h2 ah2 



dxi dx-i dx. 



(1.66) 



X=Xfc«°™ 



Vk~N(0,Rk) 



Les equations (1.62) et (1.65) constituent un modele linearise pour le cas discret. II est clair que ce 
modele de systeme linearise pent etre utilise pour mettre en application un filtre linearise de Kalman 
parce que la relation de la dynamique d'erreur et la relation associee de mesure des erreurs sont 
devenues lineaires. Ici, nous estimons seulement la valeur d'increment « I'erreur », ainsi les valeurs 
reelles de I'etat seront I'increment estime plus la valeur nominale a I'instant meme. Aussi F et H 
sont obtenus en evaluant les matrices de derivees parti elles (les Jacobiennes de / et h) le long de la 
trajectoire nominale. La position nominale (ou le vecteur d'etat) pent changer avec chaque etape du 
processus recursif, ainsi les termes de H et de F peuvent etre variables avec le temps et doivent etre 
recalcules avec chaque etape recursive. Le probleme dans la linearisation autour de la trajectoire 
nominale est que la deviation de la trajectoire reelle de la trajectoire nominale tend a augmenter 
avec le temps. A mesure que la deviation augmente, les poids des termes d'ordres superieurs dans 
I'expansion de la serie de Taylor de la trajectoire augmentent. 

La deviation de la trajectoire de reference est le vecteur d'etat et les mesures dans le modele lineaire 
sont les vraies mesures moins celles qui ont ete predites par la trajectoire nominale en I'absence du 
bruit. 

Ce type de filtre est difficile d'utilisation pour des missions prolongees parce qu'apres une certaine 
duree, la trajectoire de reference pent diverger en un point ou I'hypothese lineaire n'est plus valide a 
travers la variation du vecteur d'etat. 

Enfin, le filtrage linearise a I'avantage de permettre generalement une execution en temps reel, 
cependant, il est moins robuste vis-a-vis des approximations non-lineaires des erreurs que le filtrage 
etendu. Un remede simple et efficace pour le probleme de la deviation reside dans le remplacement 
de la trajectoire nominale par la trajectoire estimee, ce qui ramene au filtre de Kalman etendu. 
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5.2 Le Filtre de Kalman Etendu : [5] 

Le filtre de Kalman etendu « EKF » a ete developpe par Stanley F. Schmidt. II represente 
probablement I'approche la plus commune et la plus populaire pour traiter un systeme non lineaire. 
Son fonctionnement consiste simplement a linearise tous les modeles non-lineaires de sorte que le 
filtre lineaire traditionnel de Kalman puisse etre applique. L'EKF est devenu une approche standard 
pour un certain nombre d'applications d'estimation non lineaire. 

EKF est similaire a un filtre linearise de Kalman sauf que la linearisation a lieu autour de la 
trajectoire estimee du filtre plutot que de la trajectoire nominale pre-calculee (figure. 1.4). Ceci 
signifie que les derives partielles sont evaluees le long de la trajectoire qui a ete mise a jour avec les 
estimations du filtre; ce qui depend des mesures. Ainsi, le gain du filtre dependra de la sequence 
d'echantillons de mesure et ne sera pas predetermine par les previsions du modele du processus: 

Modele non lineaire du processus : Xj^ = f(xi^_j^, I^k-l) "I" ^k-1 (1-67) 

Modele de mesure: Z^ = h(Xk) + Vk (1.68) 



L'approximation de Taylor de/est faite autour de I'estimation de I'instant precedent Xk_i 
^f(x,k) , 



F(x.k) 



dx 



IX=Xk_i 



(1.69) 



L'approximation de Taylor de h est faite a la position (ou a I'etat) predite correspondante 



H(x,k) 



ah(x,k) 

ax 



IX=Xi, 



.(1.70) 



Comme dans le cas du filtre linearise de Kalman, le developpement limite donne cette fois-ci : 

Xk ~ Xk" + Fk-i(Xk-i - Xk-i)+Wk_i (1.71) 

Zk « Zk + H(Xk - Xk~) + Vk (1.72) 
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Figure 1.3: Trajectoire estimee (nominale) et reelle pour un filtre de Kalman 


etendu 
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Les equations (1.71) et (1.72) constituent un modele linearise pour le cas discret. En general, I'EKF 
est difficile en raison du bondage (le feedback) de la mesure au modele du processus, mais il arrive 
a mettre a jour la trajectoire utilisee pour la linearisation pendant que le temps evolue. 

L'avantage du EKF est qu'il est plus exploitable pour les missions prolongees. Mais il pent encore 
parfois aboutir a une trajectoire pire que la trajectoire nominale particulierement dans les cas ou 
I'incertitude initiale et les erreurs de mesure sont grandes. 

Neanmoins, le filtre linearise et le filtre etendu de Kalman sont utilises dans des applications 
differentes, chacun ayant ses propres avantages et inconvenients. 

La distinction precise entre les deux filtres (linearise et etendu) est basee sur la fonction de mesure 
h(x~) , et plus precisement sur la fagon dont elle est mise a jour : a partir de la trajectoire corrigee 
(filtre etendu) ou de la trajectoire nominale (filtre linearise). Lorsque /i(x~) est calculee avant que 
les corrections ne soient faites aux sorties inertielles, le filtre est alors un filtre de Kalman linearise 
ordinaire. Si /i(x~) est calculee apres que les corrections aient ete faites, le filtre est un filtre de 
Kalman etendu. En general, I'EKF est prefere particulierement quand la duree de la mission est 
longue, parce que dans ce cas la trajectoire de reference pent di verger de la vraie trajectoire au-dela 
des limites acceptables. 

Figure (1.5) montre les differentes etapes de I'algorithme d'estimation des parametres du systeme 
non lineaire. 
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Figure 1.5 : Extension du filtre de Kalman aux systemes non lineaire 
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5.2.1 Quelques aspects du filtre de Kalman etendu : 

Le filtre de Kalman etendu est probablement le filtre le plus largement repandu pour un systeme 
non lineaire. Cependant, il presente certains inconvenients et defauts : 

1. Une operation centrale et essentielle effectuee dans I'EKF est la propagation d'une variable 
gaussienne (GRV) par la dynamique du systeme. Dans I'EKF, la distribution d'etat est approximee 
par un GRV, qui est alors propage analytiquement par une linearisation du premier ordre du 
systeme non lineaire. Les termes negliges dans la linearisation peuvent etre relativement grands ce 
qui pent presenter de grandes erreurs 

2. dans 1' estimation de la moyenne et de la covariance a posteriori du GRV transforme. 
Ceci pent mener a une performance sub-optimale et parfois a la divergence du filtre. 

3. Le cout calculatoire de I'EKF est intensif par rapport au filtrage linearise de Kalman. 

Puisque la linearisation est faite autour des estimations obtenues a partir du filtre, nous ne pouvons 
pas calculer le parametre de filtre a I'avance, ce qui augmente la charge de calcul en temps reel. 

4. La derivation des matrices Jacobiennes n'est pas triviale dans la plupart des applications et 
introduisent souvent ensuite des difficultes d' implementation significatives. 

6. Conclusion : 

Ce chapitre a ete consacre a la presentation du filtre de Kalman qui consiste le noyau de plusieurs 
algorithmes de pistage. Au debut on a presente le filtre de Kalman dans le cadre lineaire, et apres on 
a explique deux methodes utilise pour la linearisation des problemes non lineaire. 

II faut noter que L'estimateur le plus largement repandu pour les systemes non lineaires est 
probablement le filtre de Kalman etendu (EKF). 
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